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(57) An apparatus for determining lateral speed of an 
automotive vehicle 10 includes a vehicle speed 
sensor 20, a roll rate sensor 34, a yaw rate sensor 
28, a lateral acceleration sensor 32, and a 
longitudinal acceleration sensor 36. A controller 26 
is coupled to the sensors and determines a steady 
state pitch angle and a steady state roll angle as a 
function of the lateral acceleration signal, the 
longitudinal acceleration signal, the yaw rate signal, 
and the vehicle speed signal. The controller 
determines a sliding index as a function of the 
steady state pitch signal, the steady state roll angle, 
and the roll rate signal. The controller 26 
determines lateral velocity as a function of the 
sliding index and controls the vehicle lateral motion 
based on the estimated lateral speed. 
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A METHOD AND APPARATUS FOR DETERMINING 
LATERAL VELOCITY OP A MOTOR VEHICLE 

The present invention relates generally to determining 

Uli a -- ( ^w;75 vsn icic, and rr.'^ r ^ 
particularly, to a method and apparatus for determining 
lateral velocity of an automotive vehicle. 

It is a well-known practice to control various 
operating dynamics of a motor vehicle to achieve active 
safety, using yaw and roll stability control svstems. The 
erfective operation of the various safety control devices 
requires high-accuracy and fast-response-time of th- 
operating state of the motor vehicle, regarding the "various 
road conditions and driving conditions. One importer- 

operating state used in such sv^eTs - « - , 

s > s -ems _s tne venicie lateral 

velocity. 

As a vehicle is driven, it may slide with respect to 

the road surface along the vehicle or*' =.,• . - 

y v_nicie .a.era. axis, especially 

when it is driven on a low frictio- d 3W mi 

• now mu) road surrace. 

-hxs sliding can be quantitatively estimated using the 
lateral velocity of the centre of gravity of the vehicle, 
Projected on the lateral direction of the vehicle. The 
lateral velocity combined with other . vehicle dynamic 
variables, such as longitudinal velocity and yaw rate, mav 
be used for vehicle attitude sensing. The vehicle attitude 
may be used to generate control commands for vehicle yaw and 
roll stability control systems. Lateral velocity may be 
directly measured by sensors such as optical sensors or 

globax positioning systen (G D S ) c^ne^e 

* 7 i^-^/ sensors. However, thos» 

sensors are very costly for the current vehicle dynamics 
controls. Hence it is desirable to use other available 
sensor signals to estimate the vehicle lateral velocity. 

Many known systems rely upon basic assumptions 
regarding conditions such as driving on a fiat surface (no 
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Pitcn or bank angle), or on a high mu surface, or with v 
sma.i vehicle attitude change. One example of such a 
system is found in u.S. Patent 5,742,919, which provides a 

method to estimate *r.= . 

Lfi - ne J - oterai velocity. The disclosed 

5 Ir, " t -; 0i 18 accura - e only when the road is flat, the road 

3 ' 2 - d = has very small roll motion 

A-nother known method uses a lateral acceleration sense 
signax to construct the time derivative of the veh^e 

itTT "k 10 "' 7 ^ taklnS aWay the pr ° dUCt cf <*• y« rate 
and the vehicle longitudinal velocity, since the ^oad 

condition (for example, the road bank and slope), the 
dynamic roll, and the dynamic pitch attitude of the vehicle 
wixx generate an extra component in the lateral 
acceleration, this method fails to detect accurate lateral 
velocity on banked/slope road or when the vehicle body has 
significant attitude chanaes r-r 

, . u - dnge °' F ° r exa-ple, an aggressive 

driver steering inout rr = v ra-tw 

^ xix^uL u^y cause xarge rc.i attitude 

ZlT^l ° f VehiCle/ dUring 0ff " r0ad living, "the" large 

road bank and slope will be experienced through vehicle 

a.dtude changes. A vehicle with large lateral acceleration 
manoeuvres could achieve 6 degrees of relative roll angle 
between the vehicle body and a level road surface. 

If such a vehicle is driven at 45 mph off camber on a 
10 degree banked read, the lateral acceleration sensor 

reading will be increased bv 2.7 m/s 2 sol ^ 1u «■ 

"J solely due to gravity. 

Hence, neglecting the road bank and the vehicle roll 
information could introduce an error of 2.7 ml, per second . 
That is a .second manoeuvre in this case will end uo with 
around 5.4 w/ - v lat-P*-*- „ a i„„-. 

V% * I te ' 3i vsloc ^y error which is more than 

of the vehicle speed of 45 mph. 

It is an object of this invention to provide an 
apparatus and method for providing a robust determination cf 
lateral velocity that is reliable on roads haviao banks, 
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slopes, various surface mu's (y)and when the vehicle is 
operating under changing dynamic conditions. 

According to a first aspect of the invention there is 

provided a apparatus fcr determining lateral velocity of a 

motor vehicle comprising a vehicle speed sensor for 

generating a vehicle speed signal, a roll rate sensor for 

generating a roil rate signal, a yaw rate sensor for 

generating a yaw rate signal, a lateral acceleration sensor 

for generating a lateral acceleration signal, a longitudinal 

acceleration sensor for generating a longitudinal 

acceleration signal and a controller coupled to the sensors 

for determining a steady state pitch angle and a steady 

state roil angle as a function of the lateral acceleration 

signal, the longitudinal acceleration signal, the yaw rate 

signal, and the vehicle speed signal, determining a sliding 

index as a function of the steady state pitch angle, the 

steady state roil angle and the roll rate signal, and 

determining a lateral velocity as a function of the sliding 
•index . 

The apparatus may further comprise a safety system 
coupled to the controller, the safety system operating in 
response to the lateral velocity. 

The safety system may comprise a yaw control system or 
may comprise a roil stability control system. 

The controller may determine a lateral velocity and a 
lateral velocity derivative as a function of the sliding 
index. 

According to a second aspect of the invention there is 
provided a method of controlling a vehicle comprising 
measuring a vehicle speed, measuring a roll rate of the 
vehicle, measuring a yaw rate of the vehicle, measuring a 
lateral acceleration of the vehicle, measuring a 
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longitudinal acceleration of the vehicle, determining a 
lateral velocity as a function of the longitudinal 
acceleration, the vehicle speed, the lateral acceleration, 
the yaw rate and the roll rate and ccntrclling a safety 
system in respcr.se to the lateral velocity. 

The method may further comprise determining a steady 
state pitch angle as a function of the longitudinal 
acceleration and the vehicle speed. 

The method may further comprise determining a steady . 
state roll angle as a function of the lateral acceleration, 
the yaw rate, and the vehicle speed. 

The method may further comprise determining a sliding 
index as a function of the steady state pitch angle, the 
steady state roll angle and the roll rate. 

The method may further comprise determining a lateral 
velocity derivative as a function of the sliding index. 

The safety system may comprise a yaw control system or 
may comprise a rollover control system. 

The method may further comprise generating a 
differential equation obeyed by the lateral velocity and its 
derivative by using the sliding index. 

The differential equation may be derived by projecting 
the sliding index along a yaw angle direction. 

The step of projecting the sliding index along the yaw 
angle directions may be accomplished using an anti-drift- 
integration filter. 

The method may further comprise computing yaw angle 
through pure integration and 2 7T congruent mod operation, 
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such chat the accumulated integration error cf tn 
signal is eliminated. 



-r- -» -i ^ 
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It is an advantage of the present invention that a 
closed form formula for lateral velocity and a reliable 
computation provides an estimation of the vehicle lateral 
velocity. It is a further advantage of the oresenr 
invention that the estimation of the lateral* velocity is 
accurate regardless of road profile {flat, banked, or grade* 
road surface), road surface condition (low or high nu) , a-d 
driving conditions (large or small roll /pitch/yaw combined 
motion) . 

Other advantages and features of the present invention 
will become apparent when viewed in light of the detailed 
description of the preferred embodiment when caker in 
conjunction with the attached drawings and appended claims. 

The invention will now be described by way of example 
with reference to the accompanying drawing of which: - 

Figure 1 is a diagrammatic view of a vehicle with 
variable vectors and coordinator frames according to the 
present invention; 

Figure 2 is an end view of an automotive vehicle cn a 

bank; 

Figure 3 is a side view of a vehicle on a pitch slope; 

Figure 4 is a block diagram of a stability system or 
apparatus according to the present invention; and 

Figure 5 is a flow chart of the operation according to 
a method of the present invention. 

In the following figures the same reference numerals 
will be used to identify the same components. The present 
invention is preferably used in conjunction with a safety 
system such as a yaw stability control system or a roll 
stability control system for an automotive vehicle. 
However, the present invention may also be used with a 
deployed safety system device such as airbag. The present 
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invention will be discussed below in terras of preferred 
embodiments relating to an automotive vehicle moving in a 
three-dimensional road terrain. 

» 

Referring to Figure I, an automotive vehicle 10 with a 
safety system of the present invention is illustrated with 
various forces and moments acting thereon. Vehicle 10 has 
front right and front left tyres 12a, 12b and rear right and 
rear left tyres 13a, 13b respectively. The vehicle 10 nay 
also have a number of different types of front steering 
systems 14a and rear steering systems 14b including having 
each of the front and rear wheels configured with a 
respective controllable actuator, the front and rear wheels 
having a conventional type system in which both of the front 
wheels are controlled together and both of the rear wheels 
are controlled together, a system having conventional front 
steering and independently controllable rear steering for 
each of the wheels, or vice versa. 

Generally, the vehicle has a weight represented as M S 
at the centre of gravity of the vehicle, where g=9.imis 1 and 
M is the total mass cf the vehicle. 

As mentioned above, the system may also be used with 
active/semi-active suspension systems, anti-roll bar or 
other safety devices deployed or activated upon sensing 
predetermined dynamic conditions of the vehicle. 

The sensing system 16 is coupled to a control svstem 
18. The sensing system 16 preferably uses a standard yaw 
stability control sensor set (including lateral acceleration 
sensor, yaw rate sensor, and wheel speed sensor) together 
with a roil rate sensor and a longitudinal acceleration 
sensor. The various sensors will be further described 
below. The wheel speed sensors 20 are mounted at each 
corner of the vehicle and the rest of the sensors of sensing 
system 16 are preferably mounted directly on the centre of 



gravity of the vehicle body, along the directions ^ a- . 

recoc- e rl < those skilled in the art will 

recog e , the frame fro, * and * is called a f 

-nose oragir. is located at t *e ce-r- «- ~ ■ J 
5 car body, w ^h th« * . 9-^-ty of the 

axis pointing forward * or .* 

axis n«« ~ " Curres?ondin 9 to the lateral 0 - -/ 

corresponding to the vertical or z axis n-^---- 

- =xis pointing upward. 

} The angular rates of the 

their r« nfl ociy are denoted about 

tneir respective axes as "V for th? ,, v . 

Pitch rate and * £or the y „ ^ ^ ' the 

are Ju^^:^~" T ^ ^'"^ ™ 

v^hi^l^'o e.^^ axeo of the 

" nivie s sprung mass. 

The longitudinal ^r-cicr^ ■ 

acceleration senq^r - «, " r ' e la^era,. 

sensor iS mounted on the car bodv a ^ -k* 
of gravitv w>h , y at *- he centre 

9 avit}, w.th its sensing direction along *s-ay<s a n ^ 
output is denoted as fl « . ' nd lts 

Referring now to Fiaure o 
determine, , ^g^re 2, tne present invention 

oerermines a lateral velocii-v h„ ~ 

angle «U if the „ * °"' y ^ com P eR « ting a road bank 

the ✓en.cie body has small roll atti 
resoect to th^ r-.-H ^ attitude with 

att"<tJ. T " ° C """""i™ a vehicle roll 

vehicle bodv with resr^f ^ *-u , 

-un respect to the sea level A 

r ° U a " 9U °»* be . Jse a i, the n . 

cie us.ng the present invention. 



Referring now to Figure 3, the present invention 
determines lateral velocity by compensating a slope or pitcr 
angle *** if the vehicle body has small, pitc.i attitude with 
respect to the road surface, or otherwise a vehicle pitch ' 
attitude angle > which is the global pitch angle cf the 
vehicle body with respect to the sea level. A steady state 
pitch angle may be used in the determination . Thus, the 
presence cf either road pitch or large vehicle pitch 
attitude will still allow an accurate determination of 
lateral velocity with the system of the present invention. 

Referring now to Figure 4, control system 18 is 
illustrated in further detail having a controller 26 used 
for receiving information from a number of sensors which may 
include a yaw rate sensor 28, a speed sensor 20, a lateral 
acceleration sensor 32, a roll rate sensor 34, a steering 
angle sensor (hand wheel position) 35, a longitudinal 
acceleration sensor 36, a pitch rate sensor 37 and steering 
angle position sensor 39. 

In the preferred embodiment, only two axial rate 
sensors are used. When two of these axial rates are known, 
the other may be derived using other commonly available 
sensors. Preferably, yaw rate and roll'rate are used as the 
axial rate sensors. Although pitch rate sensor 37 is 
illustrated, it may be eliminated in the preferred 
embodiment. 

In the preferred embodiment, the sensors are located at 
the centre of gravity of the vehicle. Those skilled in the 
art will recognize that the sensor may also be located off 
the centre cf gravity and translated equivaiently thereto. 

Lateral acceleration, roll orientation and speed may be 
obtained using a global positioning system (GPS) . Based 
upon inputs from the sensors, control circuit 26 may control 
a safety device 38. Depending on the desired sensitivity of 
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the system and various ether factr-a — a i- - 

->p_tq „ u "• co ' s ' "°- ai* tne sensors 
Jfc-J^ rr.ay be used •' n a re^rr^' . ,. 

, fl cc..j3crcia A embodiment. Safety c<n-ce 

38 may control an airbac 40 a- i , • c.v.ce 

active *rrnt , • 5 braklR « 41, an 

_ acve .rent steering system 42, an active rear sce-i^ 

5 SYSZe * an -suspension system «, and a , 

a^i-.o- bar system 45. or combinations thereof. r« h 0 . 
-he systems 40 -44 may have their own controller, £or ' 
activating each one. As mentioned above, the safety systet 
38 is preferably at least the active braxing system 41 

Roll rate sensor 34 and pitch rate sensor 37 may see- 
the roll condition of t*= vehic". k. i 

c — vehic.e based on sensing the 

height of one or more points on the vehicle relative to r- 
toad surface. Sensors that may be used to achieve thrs 
inciude a radar-based proximity sensor, a laser-based 
proximity sensor and a sonar-based proximity sensor. 

sense'trl "f! " ~™» -'7 nay also 

sense the roll condition based on sensing the linear or 

ro ational relative displacement or displacement velocity of 
o. or more of the suspension chassis components. ,oil nd 

t avel * 34 ' 37 My * «"«r height or 

t-avel sensor, a rotary height or travel sensor, a wheei 

speed sensor used to loox for a change in velocity, a 
steering wneel position sensor, a steering wheel veioci-y 
sensor and/or- a H*--^*- u ^ N " LOC1 ^ 
novo, a d kA ver heading command input from an 

electronic component that may include steer by wire usina a 
hand wheel or joy stick. g 3 

The roll rate may also be de'enrWH h„ o„ 

uc -<"-iiiiiea oy sens mo the* 

-res or torgue associated with the loading conditio, 7- on- 
or more suspension or chassis components. These parameters 
may oe measured by a pressure transducer in an ic 
suspension, a shoe, absorber sensor such as a load ceU . 
rain gauge, a steering system absolute or relative motor 

la era! * Pr «^ "«o«. a 

lateral force sensor or sensors, a longitudinal tire -ore, 



sensor, a vertical tire force sensor or a tire side wall 
torsion sensor. 

The roll rate of the vehicle may also be established by 
one or more of the following: translational cr rotational 
positions, velocities or accelerations of the vehicle. 
These parameters may me determined by one or more of the 
following: a roll gyro, the roil rate sensor 34, the yaw 
rate sensor 28, the lateral acceleration sensor 32, a 
vertical acceleration sensor, a vehicle longitudinal 
acceleration sensor, lateral cr vertical speed sensor 
including a wheel-based speed sensor, a radar-based speed 
sensor, a sonar-based speed sensor, a laser-based speed 
sensor or an optical-based speed sensor. 

Based on the inputs from sensors 28 through 33, 
controller 26 determines a roil condition and controls any 
one or more of the safety devices 40-45. 

Speed sensor 30 may be one of a variety of speed 
sensors known to those skilled in the art.. For example, a 
suitable speed sensor may include a sensor at every wheel 
that is averaged by controller 26. Preferably, the 
controller translates the wheel speeds into the speed of the 
vehicle. Yaw rate, steering angle, wheel speed and possibly 
a slip angle estimate at each wheel may be translated back 
to the speed of the vehicle at the centre of gravity. 
Various other algorithms are known to those skilled in the 
art. Speed may also be obtained from a transmission sensor. 
For example, if speed is determined while speeding up or 
braking around a ccrner, the lowest or highest wheel speed 
may not be used because of its error. 

From a basic dynamics consideration, there are 
kinematic relationships among the following variables for a 
moving vehicle: the lateral acceleration a \ the 
longitudinal acceleration a * , the roll rate , the yaw 
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rate »„ the vehicle reference velocity v, , the vehicle 
body ron attitude $x th£ veh . cie ^ pitch attit ^ 

(slope angle) the vehicle lateral velocity v, and the 
Pitch rate „, . These kinematic relationships can be 

5 expressed thrown the f«n~ • 

90 the following nonlinear and 
differential equations 

fl , =v, -<v,v,-*sin(0,) 

a, = v, + o,v, + ^sin(^ ) cos(0,) 

<?, = <o x + sin(0J + «,„ cos(6? )]tan(ff) (l.l) 
0, =a> J ,cos(^)- tt , iS in(^) 

As mentioned before, the determination of lateral 
velocity used through the first equation of U.x, raight 
be expressed as 

v, =a y -[a^ +gsm(0 t )cos(d f )] 
and the existing methods in current literature 
neglecting the vehicle global pitch and roll attitudes 
leads to 

Also notice that even though the vehicle global 
<0 attitudes 6. and *, are available, a careful integration 
scheme needs to be chosen in order to get v, through 
integrating a y -(*, v , +gWty h since v, could have 
^ both high frequency and low frequency cotnponenta , a 

- simple integration with high-nass filt-^ 

9n pa3a fl lter may not obtain 

cne desired result Thin 

. j SUiC - Thls difficulty i B because it is 

bard to distinguish between the integration drifting and 
the actual low frequency sliding of the vehicle. Th e 

present invention obtain* =.„ 
™ ». ^ obtains an accurate estimation 

30 regardless of auch difficulties. 



In the current vehicular yaw or roll stability 
control, a y , a x , <a M and o) y are measured sensor signals, 
and v x is known (calculated from the wheel speed sensor 
signals and the other calculated signals used in yaw 
stability controls) , while 0„ 0 y , v, and <o y are unknown. 
Hence, computing the vehicle lateral velocity from 
Equation (1.1) requires solving a set of nonlinear 
differential equations. The solution to the above 
nonlinear differential equations can be obtained through 
solving a single linear but time-varying differential 
equation. The advantage of solving a linear-time 
varying differential equation over solving nonlinear 
differential equations is that the closed-form solution 
for linear differential equations in general can be 
found, which is usually impossible for nonlinear 
differential equations. The closed-form solution 

directly calculates lateral velocity v, from the known 
signals a, , a,, a,, to, and v, by eliminating the known 
variables 0 t , $ 7 and <o y . One advantage of this 
treatment is that potential numerical errors found in 

and a> y will be eliminated. 
Therefore, the system is more robust and reliable. 

If a vehicle is driving on a stable condition, 
the lateral velocity is likely to be close to zero. In 
this case, the corresponding vehicle roll and pitch 
attitudes are denoted as 0 m and 0 m , which can be 
obtained by setting v, =0 i n the first two equations of 
Equation (l.i). 



S 

e a =asinp~^.) {1.2) 

Notice that Equation ti m *~ 
¥r% r-guacion (1.2) does not correspond 

to „ y x valueo o£ ^ vehicie ^ P 

r;:;:; in r ln thls - the ~~ ■ ~ °- 

^=asin[sin(^,)-a, t iz.j 

a . ,a y -a) v v (1.3) 
"„= a sin[— ix. j; 

*cos(4,) *cos(6>,) J 

_ „ C ° nsiderin * the vehicle attitudes are small 
enough such that the small =r,„i 

^ tne small angle assumption holds, then 

(1.3) can be simplified to the following 

. 8 

4 = a>, tentf,) tan«?,) +a >, tan(tf„)sec«?,) 

S * g 4 (l.S) 

Define the following as the slide index 

TuZ.IT' 1 velocity 9 " lafiM che X. 

<llf£.re» ta .l equation .t .ny tim. i». t „ t t 



*,(') +»,(0 , MO=ff(0 (1 . 7) 

Notice that SY characterize the strength of the eliding 
of the vehicle by using the known or the calculated and 
the measured variables. If S/=0, (1.7) leads to 

and the only solution v, satisfying the above is v,=0. 
Therefore, a small magnitude of SI implies a small 
amount of lateral velocity, hence small sliding of the 
vehicle; a large magnitude of SI implies a large 
magnitude of lateral velocity, hence large sliding of 
the vehicle. This is also the reason this quantity is 
called a sliding index. Based on the above discussion, 
the determination of the lateral velocity might be 
conducted as in the following for some threshold s of 
the sliding index 

if \Sl(k)\<s 
{ 

vehicle lateral velocity is negligible. 

} 

else if |S/(Jfc)|>j 
{ 

vehicle lateral velocity is significant 
quantitatively computing vehicle lateral velocity 



Although Equation (1.7) could be used to solve 
for lateral velocity in real-time using Tyler expansion 
Plus difference equations and numerical integration, 
such an approach is not robust and reliable for real 
time implementation due to potential uncontrollable 
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accumulative error and w * 

intention. £re9M!,Cy ° £ «" 



" V6hicU »~ «« ».(<> i. kept cc,tan t , 
for instance <yf/) = o wi *.>, v . 

velc= lty could b. direct solved . 

expression as cxosea form 



0 

Since the vehicle yaw rate is usuallv , . 

hence the above closed for. solution , tlme - Var ^ 
be useful u solution » (1.8) might not 

useful. However, if we reolae . . . 

replace the constant Q hv 
the integration of the vaw r a t-» a • . ■ 

yaw rate as m the following 

• (1.9) 

then the lateral velocity 

„ velocity and its derivative can be 

expressed as in the following 
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0 

is, the Iateral acceleration U - 10 > 

Projection of the sliding ■ „ C ° the 

the vehicle. ^ ^ «- ^ of 

m order to verify that the 

in (1 . 10) does obay the un ;;-; : 



varying differential Equation (1.7), the time derivative 

for v,(/) is found. Notice that fl, =*,(/), hence 

dt 

= cos(Q,)ft, Jj/(r) S in(n r )rfr-sb(n,)ri, )si(r)cos(Ci t )dr 

° 0 

+ sin(Q, )SI(i) sin(n, ) + cos(Q, )SI(t) cos(fl, ) 

which implies that the solution expressed in Equation 
(1.10) does satisfy Equation (1.7). 

Since the lateral velocity v,(0 and its 
derivative . *,(,) described in Equation (l.io, come from a 
kinematic equation, they are accurate regardless of the 
vehicle's driving condition, the road condition, the 
road surface condition and the vehicle platform as soon 
as the sensors are mounted on the center of gravity of 
the car body and the relative attitudes of the vehicle 
with respect to the average road surface are accurately 
calculated. Another advantage of the above computation 
of the lateral velocity is that it does not explicitly 
involve the road bank, road slope and vehicle attitude 
information, and the influence of all those variables is 
reflected by the relationship shown in the differential 
Equation <1.7) through the sliding index. 

A numerical implementation of the closed-form 
solution in Equation (l.io) is performed to allow the 
implementation in a useful manner. The yaw angle of the 
vehicle car body n, , as defined in Equation <1. 9 ), can 
be computed using the following pure integration scheme 



*« AT U th. „, UBg tiM ot che control sy8tei> _ 
«... and are the val ue3 ot th . ya „ ongle ^ ^ ^ 

rat. aansor at ti„e instant «.(* +I )4r. Be « u , e of th. 
pot.nti.1 ptobUo _ (i uj ^ ^ ^ 

do,, to th. actual _ . ngl .. Bowever , ^ 

only in sine and cosine f..^* . . « 

elimin^ j v functions, drifting may be 

eliminated by usincj the • 

using cue following congruent mod 

operation 

2* (1.12) 

Combining (1.11) and (1 12) . ' 

the following iterative 

scheme can be un B rf t-« _ 

angle ^ ^"^-mod yaw 

«* =n.-2*/iW(5j.) 



Notice that calculated in (1. 12) falls 

always within o and lit ty,~ * , n . 

ana z*. The ./JW(.) is a function which 

« the largest integer bounded by the real number . 
That is, Jloor^ always removea oufc Qf portion 

that are i„ tege r times of 2* from ^ it OUCpuCfl 

! ^ falU ^ in b -ween 0 and 2,. This 

faction is common in -c- programing language. The 
following intermediate variables may be computed. 

The projections of the sliding index SI along 
«e yaw angle directions can now be computed based on 
the computed Q . Def ine 



Slsinint^ jsi(T)sm(Cl r )d; 



0 

t 



^/cosint = \si{z)cos{Q t )dv 

0 

then the numerical computation of them using the 
following anti-drift-integration filter 

l AmK* )-• — — 

l-c,z l +c 2 z 2 

can be obtained as the following 

SI smint^, = ^smint^-c^sinint^ 

+dlSI ltt sm t J-SI t _ l sin(n t J) 
S/sinuit^, = Cl 5/sinint t -c } 5ysinint t ., (1.13) 

Using the numerical scheme shown in Equation 
(1-13). the following computation for the lateral 
velocity and its derivative based upon the sliding index 
along the yaw angle direction is shown as 

(1.14) 

v, w =sm(n fw )5/ sinint^+cosCn^^cosint^, 

As mentioned above, a control signal may then 

be developed based on the lateral velocity and perhaps 
the lateral velocity derivative found in Equation 
(1.14). For example, a roll or a yaw stability control 
system may derive the control signal therefrom. Of 
course, multiple systems may simultaneously use the 
lateral velocity and/or the lateral velocity derivative 
in its computations. 

Referring now to Figure 5, a summary flow 
chart illustrating the process is illustrated. The 
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various sensors are read in step 70. In the following 
examples the yaw rate sensor 28, the roll rate sensor 
34, the speed sensor 20, lateral acceleration sensor 32, 
and longitudinal acceleration sensor 36 are used. A 
steady state pitch and roll angle in step 72 is obtained 
from Equation (1.2) above. A sliding index is 
determined in step 74 which corresponds to Equation 
(1.6) above* The eliding index is projected along the 

yaw angle direction in step 76. The yaw angle 

projection is set forth in Equation (1.13). 

Based upon the projection of the sliding index 
along the yaw angle direction, step 78 determines a 
linear time varying differential equation as a function 
of the sliding index projection. in step 80, the 
lateral velocity and the velocity derivative are 
obtained. In step 82, a control system such as a safety 
system is controlled in response to the lateral velocity 
and/or the lateral velocity derivative. 
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Claims 

1. An apparatus for determining lateral velocity of 
motor vehicle comprising a vehicle sceed sensor for 
generating a vehicle speed signal, a roil rare sensor for 
generating a roil rate signal, a yav; rate sensor for 
generating a yaw rate signal, a lateral acceleration sensor 
for generating a lateral acceleration signal, a lor.gitudina 
acceleration sensor for generating a longitudinal 
acceleration signal and a controller coupled to the sensors 
for determining a steady state pitch angle and a steady 
state roll angle as a function of the lateral acceleration 
signal, the longitudinal acceleration signal, the yaw rate 
signal, and the vehicle speed signal, determining a sliding 
index as a function of the steady state pitch angle, the 
steady state roll angle and the roll rate signal, and 
determining a lateral velocity as a function of the sliding 
index . 

2. An apparatus as claimed in claim 1 further 
comprising a safety system coupled to the controller, the 
safety system operating in response to the lateral velocity 

3. An apparatus as claimed in claim 2 wherein the 
safety system comprises a yaw control system. 

4. An apparatus as claimed in claim 2 wherein the 
safety system comprises a roil stability control system. 

5. An apparatus as claimed in any of claims 1 to 4 
wherein the controller determines a lateral velocity and a 
lateral velocity derivative as a function of the sliding 
index, 

6. A method of controlling a vehicle comprising 
measuring a vehicle speed, measuring a roll rate of the 
vehicle, measuring a yaw rate of the vehicle, measuring a 



lateral acceleration of the vehicle, measuring a 
longitudinal acceleration of the vehicle, determining a 
lateral velocity as a function of the longitudinal 
acceleration, the vehicle speed, the lateral acceleration, 
the yaw rate and the roll rate and controlling a safety 
system in response to the lateral velocity. 

7. A method as claimed in claim 6 wherein the method 
further comprises determining a steady stace pitch angle as 
a function of the longitudinal acceleration and the vehicle 
speed. 

3. A method as claimed in claim 6 or in claim 7 
wherein the method further comprises determining a steady- 
state roil angle as a function of the lateral acceleration, 
the yaw rate, and the vehicle speed. 

9. A method as claimed in any of claims 6 to 8 
wherein the method further comprises determining a sliding 
index as a function of the steady state pitch angle, the 
steady state roll angle and the roll rate. 

10. A method as claimed in claim 9 wherein the method 
further comprises determining a lateral velocity derivative 
as a function of the sliding index. 

.11. A method as claimed in any of claims 6 to 10 
wherein the safety system comprises a yaw control system. 

12. A method as claimed in any of claims 6 to 1C 
wherein the safety system comprises a rollover control 
system. 

13. A method as claimed in claim 9 further comprising 
generating a differential equation obeyed by the lateral 
velocity and its derivative by using the sliding index. 



14. A method as claimed in claim 13 wherein the 
differential equation is derived by projecting the sliding 
index along a yaw angle direction. 

15. A method as claimed in claim 14 wherein the- step 
of projecting the sliding index along the yaw angle 

directions is accomplished using an anti-drift- integration 
filter. ■ 

16. A method as claimed in any of claims 6 to 15 
further comprising computing yaw angle through pure 
integration and 2' T congruent mcd operation, such that the 
accumulated integration error of the real signal is 
eliminated. 

17. An apparatus for determining lateral velocity of a 
motor vehicle substantially as described herein with 
reference to the accompanying drawing." 

18. A method of controlling a vehicle substantially as 
described herein with reference to the accompanying drawing. 




• Patent • 
% Qflicc | 




INVESTOR IN PEOPLE 



Application No: 
Claims searched: 



GB 0309704.5 
All 



Examiner: 
Date of search: 



Jacob Collins 
1 9 August 2003 



Patents Act 1977 : Search Report under Section 17 

Documents considered to be relevant: 



Category 

Y 
Y 
Y 
Y 
Y 



Relevant 
to claims 

6, 11 & 12 
6, 11 & 12 
6, 11 & 12 
6, 11 & 12 
6, 11 & 12 



Identity of document and passage or figure of particular relevance 



GB 2280651 A 
EP 1 1 1 0834 A2 
US 5408411 
EP 0827852 A2 
JP 040189631 



(DAIMLER-BENZ) 
(FORD) 

(NAKAMURA ET AL) 
(FORD) 

(KAYABA) 



Categories: 

X Document indicating lack of novelty or inventive step 

Y Document indicating lack of inventive step if combined 
with one or more other documents of same category. 

& Member of the same patent family 



A Document indicating technological background and/or state of the art. 

P Document published on or after the declared priority date but before the 
filing date of this invention. 

E Patent document published on or afteT, but with priority date earlier 
than, the filing date of this application. 



Field of Search: 

Search of GB, EP, WO & US patent documents classified in the follow ing areas of the UKC V : 

GIN 




Worldwide search of pate nt documents classified in the following areas of the IPC 7 : 



B60T 



The followjnp on l ine and Other databases have been used in the preparing , of this search r 

WPI, EPODOC, JAPIO 



An Executive Agency ofihc Department ofTracIc and Industry 



This Page is Inserted by IFW Indexing and Scanning 
Operations and is not part of the Official Record 

BEST AVAILABLE IMAGES 

Defective images within this document are accurate representations of the original 
documents submitted by the applicant. 

Defects in the images include but are not limited to the items checked: 

□ BLACK BORDERS 

* 

□ image cut off at top, bottom or sides 
G'faded text or drawing 

□ blurred or illegible text or drawing 

« 

□ SKEWED/SLANTED IMAGES 

□ COLOR OR BLACK AND WHITE PHOTOGRAPHS 

□ GRAY SCALE DOCUMENTS 

□ LINES OR MARKS ON ORIGINAL DOCUMENT 

□ REFERENCE(S) OR EXHffiIT(S) SUBMITTED ARE POOR QUALITY 

□ OTHER: '. 

IMAGES ARE BEST AVAILABLE COPY. 
As rescanning these documents will not correct the image 
problems checked, please do not report these problems to 
the IFW Image Problem Mailbox. 



